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REPORT SUMMARY 


This is a semiannual report presenting the j'esearch results obtained from the research grant 
entitled “Control of Robot Manipulator Compliance,” funded by the Goddard Space Flight Center 
(NASA) under a research grant with Grant Number NAG 5-780, for the period between August 
1, 1990 and January 1, 1991. 

In this report we present the kinematic analysis and implementation of a 6 DOF robotic 
wrist which is mounted to a general open-kinematic chain manipulator to serve as a testbed for 
studying precision robotic assembly in space. The wrist design is based on the Stewart Platform 
mechanism and consists mainly of two platforms and six linear actuators driven by dc motors. 
Position feedback is achieved by linear displacement transducers mounted along the actuators 
and force feedback is obtained by a 6 DOF force sensor mounted between the gripper and the 
payload platform. The robot wrist inverse kinematics which computes the required actuator 
lengths corresponding to Cartesian variables has a closed-form solution. The forward kinematics 
is solved iteratively using the Newton-Raphson method which simultaneously provides a Modified 
Jacobian Matrix which relates length velocities to Cartesian translational velocities and time rates 
of change of Roll-Pitch-Yaw angles. Results of computer simulation conducted to evaluate the 
efficiency of the forward kinematics and Modified Jacobian Matrix are presented and discussed. 



1 INTRODUCTION 

Motions robots perform during a robotic operation in space can be divided into gross motion and 
fine motion. Gross motion permits low positioning accuracy, e.g. in obstacle avoidance, while fine 
motion requires very high positioning accuracies, usually of thousands of an inch, e.g. in mating 
and demating space-rated connectors. Traditional robot manipulators are anthropomorphic 
open-kinematic chain (OKC) mechanisms whose joints and links are actuated in series. OKC 
manipulators generally have long reach, large workspace and are capable of entering small spaces 
because of their compactness. However, their cantilever-like structure causes OKC manipulators 
to have low stiffness and consequently undesirable dynamic characteristics, especially at high 
speed and large payload. In addition, they have low strength-to- weight ratios due to the fact 
that the payload is not uniformly distributed to the actuators. Finally, the fact that relatively 
large position error occurs at the last link because the joint errors are accumulated throughout 
the mechanism suggest that OKC manipulators are not suitable for high precision tasks. As a 
result, it was proposed in [1,2] that a robotic end-effector capable of performing high precision 
motion be mounted to a general OKC manipulator to perform fine motion while the OKC 
manipulator is solely responsible for carrying out gross motion during a telerobotic operation. 
Closed-kinematic chain (CKC) mechanism has been selected for the design of the end-effector 
because even though it has relatively small workspace and low maneuverability, it possesses high 
positioning capability produced by its high structural rigidity and noncumulative actuator errors. 
CKC mechanism also has higher strength-to-weight ratios as compared to OKC mechanism 
because the payload is proportionally distributed to the links. In addition, the inverse kinematic 
problem of the CKC mechanism has simple closed-form solutions. Implementation of the CKC 
mechanism concept first appeared in the the Stewart platform [3] which was originally designed 
as an aircraft simulator. A typical Stewart Platform consists of two platforms driven by a 
number of parallel actuators and is often referred as parallel mechanism or parallel manipulator. 
The invention of the Stewart platform has attracted tremendous robot designer’s attention and 
its mechanism was used in many robotic applications [4,18]. Dieudonne [4] and his coworkers 
derived an actuator extension transformation and presented experimental results of a Stewart 
Platform- based simulator built at NASA Langley Research Center to train aircraft operators. 
A finite element program was used by Hoffman and McKinnon [5] to simulate the motion of the 
Stewart Platform whose mechanism was later applied by McCallion and Truong [6] to design an 
automatic assembly table. Hunt [7] conducted a systematic study of in-parallel-actuated robot 
arms and presented the structural kinematic problem this type of manipulators [9]. Sugimoto 
and Duffy [8] developed a general technique to describe the instantaneous link motion of a 
single closed-loop mechanism by employing linear algebra elements to screw systems. In order 
to study autonomous robotic assembly, Premack [10] and his coworkers employed the Stewart 
Platform mechanism to build a passive compliant robot end-effector whose control problem was 
investigated by Nguyen and others [11]. Kinematic problems and practical construction of the 
Stewart Platform were later considered by Yang and Lee [12] and Fichter [13], respectively. 
Sugimoto [14] studied kinematics and dynamics of parallel manipulators and Lee [15] derived 
dynamical equations for a 3 degree-of- freedom (DOF) CKC manipulator. Nguyen and Pooran 
[16] developed a learning control scheme for a 2 DOF CKC manipulator performing repetitive 
tasks. Trajectory planning schemes were developed by Nguyen et al [19] for Stewart Platform- 
based manipulators whose actuators are driven by stepper motors. 
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Recently a robotic wrist possessing 6 DOF’s was designed and built at the Goddard Space 
Flight Center (NASA) based on the mechanism of the Stewart Platform to serve as a testbed 
for studying high precision robotic operations in space. This report presents the development 
and implementation of kinematic transformations for the robotic wrist. This report is organized 
as follows. Next section describes the main components of the robotic wrist. Then a kinematic 
analysis is performed to provide a closed-form solution to the inverse kinematic transformation. 
After that, a computationally efficient solution is derived for the forward kinematic transfor- 
mation using the Newton-Raphson method which simultaneously provides a Modified Jacobian 
Matrix. Finally evaluation of the forward kinematic transformation and Modified Jacobian 
Matrix is done by means of computer simulation whose results are presented and discussed. 

2 THE STEWART-PLATFORM BASED ROBOTIC WRIST 

Figure 1 presents a robot manipulator of the Intelligent Robotic Laboratory (IRL) at the God- 
dard Space Flight Center (NASA), which consists of a 6 DOF Cincinnati T3 robot and a 6 DOF 
Stewart Platform-based robotic wrist mounted to the last link of the T3 robot. The manipulator 
has a total of 11 DOF’s since one DOF of the wrist is identical to that of the T3 Robot. The 
main function of the T3 robot is to perform gross motion, for example to bring the robotic 
wrist into its workspace and then let the wrist carry out fine motion required for high precision 
operations such as assembly of parts, mating connectors, etc. As shown in Figure 2, the design 
of the robotic wrist is based on the mechanism of the Stewart Platform. It mainly consists of 
a payload platform, a base platform, six linear actuators and a gripper attached to the payload 
platform. The payload platform is coupled with the base platform by the actuators each of 
which is composed of a NSK ballscrew assembly mounted axially with a PMI dc motor. The 
motors drive the ballscrews to extend or shorten the actuator lengths whose variations will in 
turn produce the motion of the payload platform relative to the base platform. The actuator 
lengths are measured by six BALLUFF linear displacement transducers (LDT) mounted along 
the actuators. Forces/torques exerted by the gripper is acquired through a JR 3 Universal Force- 
Moment Sensor System mounted between the gripper base and the payload platform. Each end 
of the actuator links is mounted to the platforms by 2 DOF universal joints. The LDT signals 
are sent to the IRL Local Area Network (LAN) via an Ethernet board and a Data Translation 
input board resided in a PC/386. An Apollo workstation will take the sensor signals off the 
LAN by means of another Ethernet board, performs all necessary computations for the imple- 
mentation of control schemes, coordinate transformations, etc., and sends the actuating signals 
to the PMI motor drives via a Data Translation output board. 

3 THE INVERSE KINEMATIC TRANSFORMATION 

This section develops an inverse kinematic transformation for the robot wrist, which determines 
the required actuator lengths for a given configuration composed of Cartesian position and 
orientation of the payload platform with respect to the base platform. Frame assignment to the 
robot wrist is illustrated in Figure 3 where two coordinate frames {P}, and {B} are assigned to 
the payload and base platforms, respectively. The origin of Frame {P } is located at the centroid 
P of the payload platform, the zp-axis is pointing outward and the xp-axis is perpendicular 
to the line connecting the two attachment points P\ and P&. The angle between P\ and P 2 is 
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denoted by Op. A symmetrical distribution of joints on the payload platform is achieved by 
setting the angles between Pi and P 3 and between P 3 and P 5 to 120°. Similarly, Frame {B} 
has its origin at the centroid B of the base platform. The x B -axis is perpendicular to the line 
connecting the two attachment points Pi and Be the angle between Pi and P 2 is denoted by 
0 B . Also the angles between Pi and P 3 and between P 3 and P5 are set to 120° in order to 
symmetrically distribute the joints on the base platform. The Cartesian variables are chosen 
to be the relative position and orientation of Frame {P} with respect to Frame {B} where the 
position of Frame {P} is specified by the position of its origin with respect to Frame {B}. Now 
if we denote the angle between PP t and xp by A 1? and the angle between PPi and x B by A; for 
i=l, 2 ,. . . , 6 , then by inspection we obtain 

A, = 60i° - A, = 60i° - for i = 1,3,5 (1) 

and 

Ai = Ai-i+*s; A,* = \i-i + e Py for i = 2,4, 6 . ( 2 ) 

Furthermore, if Vector ^p,- = ( pi x pi y pi z describes the position of the attachment point P, 
with respect to Frame {P}, and Vector = (b{ x b{ y bi z ) 7 the position of the attachment point 
Bi with respect to Frame {B}, then they can be written as 

F Pi — [ rpcos(Xi) rpsin(Xi) 0 j (3) 


and 



r B cos{\i) 


rssin(Ai) 



( 4 ) 


for i=l,2,. .. ,6 where rp and rg represent the radii of the payload and base platforms, respec- 
tively. 

We proceed to consider the vector diagram for an ith actuator given in Figure 4. The 
position of Frame {P} is represented by Vector B d = [x y z] T which contains the Cartesian 
coordinates x, y, z of the origin of Frame {P} with respect to Frame {B}. The length vector 
B q t - = ( q ix q iy q iz ) T , expressed with respect to Frame {B} can be computed by 


B n - B 


q; = D x, + fi p 


( 5 ) 
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which is the representation of B p, in Frame {B} and is the Orientation Matrix representing 
the orientation of Frame {P} with respect to Frame {B}. 

Thus the length /, of Vector B q; can be computed from its components as 


U = \fe + <tfy + 9.V 


or 


h = \J{xi + u,) 2 + (2/i + Vi) 2 + [z{ + tn;) 2 


We obtain from (3)-(4) 


“ir ' v iy 

and from the properties of orientation matrix 


pl + p 2 iy + pl = r 2 P , 

bl + bl + bl = r%. 


r 2 u + r h + r 3i = r h + *22 + r L = r?s + 4? + rh = 1 


( 10 ) 

( 11 ) 

( 12 ) 

(13) 

(14) 


and 


2™1 1 r*l 2 T f 21 7*22 T ^31^32 = 0 

^11^13 + r 21 I- 23 + r 3 ir 3 3 = 0 

r ll r 13 + r 22 r 23 + r 32 r 32 = 0- 


(15) 


Employing (12)-(15), (10) can be rewritten as 

/,- 2 = + 2/ 2 + T Tp -f rp + 2(rnPi x + r \2Piy){ x ~ bix ) 

+2(r2ip, x + r22Piy)(y — b{ y ) + 2(r-siPi x + r^Piy) z — 2(x6; x + ybiy), (16) 


for i=l,2,. . . ,6. 

Equation (16) represents the closed-form solution to the inverse kinematic problem in the 
sense that required actuator lengths /, for i = l,2,. ..,6 can be determined using (16) to yield 
a given Cartesian configuration composed of Cartesian position and orientation of Frame {P} 
with respect to Frame {B}. 


Specification of the Payload Platform Orientation 

The orientation of Frame {P} with respect to Frame {B} can be described by the orientation 
matrix B R as shown in (9) which requires nine variables r,j for ij=l,2,3 from which six are 
redundant because only three are needed to specify an orientation [21]. There exist several ways 
to specify an orientation by three variables, but the most widely used one is the Roll-Pitch-Yaw 
angles a, / 3 , and 7, which represent the orientation of Frame {P}, obtained after the following 
sequence of rotations from Frame {B}: 

1. First rotate Frame {B} about the x/j-axis an angle 7 ( Yaw) 

2. Then rotate the resulting frame about the ye-axis an angle /? (Pitch) 

3. Finally rotate the resulting frame about the ze-axis an angle a (Roll). 
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The orientation represented by the above Roll-Pitch-Yaw angles is given by 

ca c/3 ca s/3 57 - sa C7 ca s/3 cj + sa 57 
= R rpy = sa c(3 sa s/3 s~f + ca ci sa s/3 c*) - ca s-f . (17) 

-s/3 c/3 s-y c/3 c'i 


4 THE FORWARD KINEMATIC TRANSFORMATION 

This section considers the development of the forward transformation which transforms the actu- 
ator lengths U for i=l,2 v . . ,6 measured by six LDT’s into the Cartesian position and orientation 
of the payload platform with respect to the base platform. The forward kinematic problem can 
be formulated as to find a Cartesian position specified by x, y, z and an orientation specified by 
Roll-Pitch- Yaw angles a, /3, and 7 to satisfy Equation (16) for a given set of actuator lengths 
li for i=l,2,. . . ,6. In general, there exists no closed-form solution for the above problem since 
Equation (16) represents a set of 6 highly nonlinear simultaneous equations with 6 unknowns. 
Consequently iterative numerical methods must be employed to solve the above set of nonlinear 
equations. In the following we will present the implementation of Newton-Raphson method for 
solving the forward kinematic problem. 

In order to apply the Newton-Raphson method, first from (11) we define 6 scalar functions 
/{(a) = ( x , + Uif + (yi + Vif + (z t + w;) 2 - /; 2 = 0 (18) 


for i=l,2,. . . ,6, where the vector a is defined as 


a = Ol «2 fl 3 a 4 a 5 a 6 


and then employ the following algorithm [20] to solve for a: 


Newton-Raphson Algorithm 
Step 1: Select an initial guess a. 

Step 2: Compute the elements of ®R using (17) for i, j=l,2,. . . ,6. 

Step 3: Compute 27,2/t, ?i, using (7) and U{, Vi, Wi using (9) for i=l,2,. . . ,6. 

d f ' 

Step 4: Compute /,( a) and Ay = -gfij using (18) for i, j=l,2,...,6. 

Step 5: Compute B x = -/,( a) for i=l,2 ,...,6 . If I B i \< iol f (tolerance), stop and select 

a as the solution. 

Step 6: Solve Yl*j=i Aij$ a j = f° r ^ a j f° r i j=l,2 v . . ,6 using LU decomposition. If Hj=i ^ a j ^ 

tola (tolerance), stop and select a as the solution. 

Step 7: Select a neu; = a + (5a and repeat Steps 1-7. 

1 cot = cos a, and sat = sin cr. 
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Computation of Partial Derivatives 

In order to minimize the computational time of the Newton-Rap hson Algorithm, the expressions 
for computing the partial derivatives in Step 4 of the algorithm should be simplified. First using 
(9) and ( 17 ), the partial derivatives of u { , and with respect to the angles a, /?, and 7 can 
be computed as follows: 



dui dui dui 

- = w =ccv,, W = »,r, 3, 

(20) 


dv{ dv{ dvi 

(21) 

dwi 

da 

dwi , dwi 

= 0; = -(c/3 pi x + s (3 si p ty ); — = p iy r^. 

(22) 

From (7), we note that 

dx, _ dyi _ dzi _ 
dx dy dz 

(23) 

Employing (20)-(23), we 

obtain after intensive simplification 



s* -§&-!&= 

0(i\ ox axi 

(24) 


M = ^ = |4 = 2(5 ( + ,). 

oa2 oy oyi 

(25) 


oa 3 oz ozi 

(26) 


7 T— = ~T~ “ 2 ( — XjVj + 
004 <70 

(27) 

df L = 

da 5 

= 2[(-x,- ca + yi sa)wi - ( Pi x cf 3 + p iy s (3 S7)z t ] 
op 

(28) 


r\ r 0 f 

~ = -77 1 = 2 p iy (xir 13 + y,r 2 3 + ^r 33 ). 
oa$ <77 

(29) 


Modified Jacobian Matrix 

Conventionally the Manipulator Jacobian Matrix is defined as a matrix relating joint velocities to 
Cartesian velocities composed of translational velocities and rotational velocities. For the robot 
wrist, since actuator lengths are selected as joint variables, the time rates of change of actuator 
lengths ii, I2,..., 16 are joint velocities. However in order to utilize the partial derivatives 
computed for the forward kinematic transformation, we define here the velocities of Cartesian 
positions of the payload platform with Frame {B}, namely i, y and i as the translational 
velocities and the velocities of the Roll-Pitch-Yaw angles a, /?, and 7 as the rotational velocities . 
The matrix J which relates the length velocities to translation velocities and Roll-Pitch-Yaw 
angle velocities is therefore called The Modified Jacobian Matrix. Denoting 

a = (di c 12 <23 <2.4 <25 = (£ y z a 7 )^ (30) 
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and 


(31) 


1 = (/j l 2 I3 I4 I5 /e) T 1 


we obtain 


a = J m b 

(32) 

or 

1 = Jm _1 a- 

(33) 

0 /. , 

where Jm is the Modified Jacobian Matrix. Calling kij = the ij-element of Jm > from 

( 33 ) we have 

6 6 f)i 

h = E = E 

j=l j = l J 

(34) 

Now solving for / t 2 in (18) yields 


/j 2 = (£i + Ui ) 2 + (yi + Vi ) 2 + (Zi + Wi ) 2 

= /, (35) 

for i=l,2,. .. , 6 . Recognizing that /; is a function of x t , yj, 5,-, a, 
differentiate both sides of (34) with respect to time to obtain 

/?, and 7 , and using (23), we 

J=\ J 

(36) 

from which solving for U yields 

: A l dfi. 

' ~t-'2l i da j ay 

i ~ 1 J 

(37) 


Now comparing (34) and (37) and noting from (35) and (18) that f£r = JA, we arrive at 

1 dfi 


2 /, daj 


(38) 


where can be obtained from Step 4 of the Newton-Raphson Algorithm using (24)-(29). In 
other words, we just showed that the inverse of the Modified Jacobian Matrix can be computed 
using the results of the forward kinematic transformation. 

5 COMPUTER SIMULATION STUDY 

In this section we will report results obtained from the computer simulation conducted to study 
the efficiency of the developed inverse and forward kinematic transformations as well as the 
Modified Jacobian matrix. The simulation scheme employed in the study is illustrated in Figure 
5. In the upper loop, a set of Cartesian test trajectories comprised by Vector a are converted 
to the corresponding actuator length trajectories comprised by Vector 1 via the inverse kine- 
matic transformation. The Newton-Raphson Algorithm implementing the forward kinematic 
transformation is then applied to convert 1 to a c , a vector composed of computed Cartesian 
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trajectories corresponding to 1. The computed Cartesian trajectories are then compared with 
the Cartesian test trajectories and the resulting errors are recorded. In addition, the test length 
velocities contained by i are obtained by differentiating 1 with respect to time. In the lower 
loop, the Cartesian test velocities comprised by Vector a are obtained by differentiating a with 
respect to time. The Cartesian test velocities a are then converted to the corresponding length 
velocities, i c using the Inverse Modified Jacobian Matrix Ja/ _1 - Errors in length velocities are 
then obtained by comparing the computed length velocities with the test length velocities. The 
developed transformations are implemented in C and graphical facility is provided by MATLAB. 
Computer simulation results for two test ca.ses are presented and discussed below. 

Test Case Is Straight Line Motion 

Figure 6-8 present the computer simulation results of the case in which the Cartesian test 
trajectories specify a straight line in the x-y plane of the base frame. The straight line motion 
is described by 

x(t) = x 0 + 6.3[1 + 3exp(-^f) - 4exp(-^-*)] ( 39 ) 

3 5 3.5 

y(t) = yo + 9.45[1 + 3exp(-— t) - 4exp( — «-*)] ( 40 ) 

where the initial position is denoted by xo — -3.5 inches, yo = -5 inches. The computer simu- 
lation was conducted with a sampling time of 0.05 second on a SUN workstation for 5 seconds. 
According to Figure 6 which presents the errors in Cartesian positions x, y, z, a maximum error 
of -2.146 microinch occurs in y-position and a maximum Root-Mean-Square (RMS) error of 
0.7615 microinch occurs in x-position. The errors in Roll-Pitch- Yaw (RPY) angles are showed 
in Figure 7 where a maximum error of 0.156 microradian and a maximum RMS error of 0.623 
microradian occur in the Roll angle. According to Figure 8 which presents the errors in length 
velocities, relatively large errors exist at the beginning of the simulation and settle down almost 
to zero after about lsec. A maximum error of 0.1619 inch/sec and a maximum RMS error of 
0.0361 inch/sec occur in the second actuator length. 

Test Case 2: Circular Motion 

Computer simulation results of the case in which the Cartesian test trajectories specify a circular 
motion are presented in Figures 9-11. The circular motion consists of 3 segments described by 


x(t) = R cos$ t ; y(t) = Rsin*i for ti-i<t<ti for i = 1,2,3 (41) 

where the circular path radius R = 5 inches, and 

$i(0 = 0o + ? (42) 

$ 2 ( 2 ) — 0i + ~ h), (43) 

*3(0 = 4>0- §(*3 - tf ( 44 ) 
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with <f>o — 0 radian; <p\ = $\(t\) radian, angular velocity u = (3t\ radian/sec and the angular 
acceleration (3 = 2n/[ti(t 3 ~ti)\ radian/sec 2 . The computer simulation was conducted on a SUN 
workstation with a sampling time of 0.05 second for 5 seconds. 

The errors in Cartesian positions x, y, z are showed in Figure 9 where there exist a maximum 
error of -2.384 microinch and a maximum RMS error of 0.8737 microinch in x-position. According 
to Figure 10 which presents the errors in RPY angles, a maximum error of 0.154 microradian 
and a maximum RMS error of 0.0607 microradian occur in Roll angle. The errors in length 
velocities are reported in Figure 11 where a maximum error of -0.049 inch/sec occurs in the fifth 
actuator length and a maximum RMS error of 0.025 inch/sec occurs in both the first and the 
sixth actuator lengths. The complete simulation results are tabulated in Table 1. 



Straight Line Motion 

Circular Motion 

Max Error 

RMS Error 

Max Error 

RMS Error 

x \jiin] 

-1.907 

0.7615 

-2.384 

0.8737 

y [/**«] 

-2.146 

0.7313 

1.9374 

0.7367 

z [fiin\ 

-1.907 

0.2684 

-1.907 

0.2691 

a [firad] 

0.156 

0.0623 

0.154 

0.0607 

/3 [firad] 

0.103 

0.0407 

-0.113 

0.0461 

7 [ firad ] 

0.106 

0.0445 

0.111 

0.0473 

h IS] 

0.1546 

0.0343 

0.0419 

0.0250 


0.1619 

0.0361 

-0.0486 

0.0196 

h [£] 

-0.0433 

-0.0177 

0.0473 

0.0215 

'.(SI 

0.0955 

0.0212 

0.0478 

0.0216 

<5 IS] 

0.1084 

0.0239 

-0.0494 

0.0197 

MS] 

-0.0369 

-0.0166 

0.4919 

0.0250 


Table 1: Computer simulation results 

6 CONCLUSION 

This report presented a 6 DOF robotic wrist built at Goddard Space Flight Center (NASA) 
to investigate the feasibility of autonomous robotic operations in space. Designed based on 
the mechanism of the Stewart Platform, the wrist mainly consists of two platforms, six linear 
actuators, and a sensor system and is mounted to a Cincinnati T3 robot to study high preci- 
sion robotic assembly. Using vector analysis and coordinate frame assignment, a closed-form 
solution was obtained for the inverse kinematic transformation to convert Cartesian variables 
into required actuator lengths. The inverse kinematic equations were then extensively simpli- 
fied and then applied to develop an iterative solution for the forward kinematic transformation 
converting actuator lengths to Cartesian variables using the Newton- Raphson method. It was 
proved that a Modified Jacobian Matrix relating length velocities to translational velocities and 
velocities of RPY angles can be obtained as part of the forward kinematic transformation. Re- 
sults of computer simulation conducted to evaluate the developed transformations and Modified 
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Jacobian matrix showed that the conversion accuracies were excellent with very negligible er- 
rors. Current research activities focus on implementing the developed transformations for use in 
real-time control of the robot wrist motion. Control schemes such as fixed-gain PID controller 
and adaptive controller are also currently developed in the IRL to control the motion of the 
wrist during a high precision assembly of NASA hardwares. 
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Figure 1: The GSFC-IRL robot manipulator 



Figure 2: The Stewart Platform-based robotic wrist 
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Figure 3: Frame assignment for the robotic wrist 



Figure 4: Vector diagram for the ith actuator 
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Figure 5: Computer simulation scheme 
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Figure 9: Circular motion, errors in x, y, z coordinates 

X (solid), y (dashed), Z (dashed-dotted) 
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Figure 11: Circular motion, errors in length velocities 
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